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ABSTRACT 


Energy storage is very limited in AUV’s. To assist with energy management, data 
gathering missions have been proposed where the vehicle should sit on the bottom and gather 
acoustic/video/chemical data over extended periods of time. In this grounding senario while 
thrusters may be used, they are less desirable because of their high energy consuption and 
restricted use close to the ocean floor. The purpose of this work is to study a low cost, simple soft 
grounding capability for a submersible vehicle using controllable ballast. The ballast system 
based on the NPS Phoenix AUV is designed to control weight addition into or out of two ballast 
tanks. The developed control law adjusts the pump flow rate keeping the pitch angle and depth 


rate within the limits. Results for a soft grounding operation have been obtained using simulation. 
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I. INTRODUCTION 


A. INTRODUCTION 

Energy storage is very limited in AUV’s. To assist with energy management, data gathering 
missions have been proposed where the vehicle should sit on the bottom and gather 
acoustic/video/chemical data over extended periods of time. In this grounding senario, thrusters 
may be used. However, there are two disadvantages for this method: high energy consumption and 
restricted use close to the ocean bottom. The motivation for this thesis is to study a low cost, simple 
soft grounding capability for a submersible vehicle using controllable ballast. For simplicity, water 
ballast is considered. The design of the control system 1s based on the NPS Phoenix AUV. The 
ballast system is designed to control the weight addition into or out of the two ballast tanks where 
instead of 2 bang-bang or a fuzzy logic controller which actually turns on and turns off the pumps , 
the developed control law controls the pump flow rate, keep the pitch angle and depth rate within 
limits... 
B. BACKGROUND 

Ballast control of vehicles is not a new subject and we can find many examples beginning 
in the 1900’s, the non-rigid airships are very good examples of ballast control. One of the most 
important elements of a non-rigid airship is the ballonet-system. A ballonet as seen in Figure 1-1 is 
an airbag (one or two of them) inside the envelope, which is provided with air from a blower or 
directly from the engine unit. The air could be removed from the ballonet through the valves. If the 
airship has a front and aft ballonet then the height of the airship can be steered. For example, if the 
aft ballonet is filled with more air, then the airship will beanie heavier in the rear part of the | 
envelope and the ship will incline increasing the altitude of the ship by using the engines.As Figure 


1-2 depicted, the airship can also be trimed through a front and aft ballonet [Ref. 1]. 








For most of the maneuvering underwater vehicles, the depth control 1s normally provided 
by hydroplanes. As an example, consider the NPS Phoenix AUV. It has two sets of control 
surfaces, namely the bow and the stern planes. At low speed, the control surfaces cannot provide 
enough control authority and the ballast control problem is very complex due to nonlinear, time- 
varying, uncertain hydrodynamics. There are some designs that used bang-bang control system 
[Ref. 2]. The ARPA’s Unmanned Undersea Vehicle (UUV) employs a fuzzy logic ballast 
controller which is comparable with the performance that can be obtained from standard control 


techniques, but does not require traditional linear or nonlinear design methods. 










Bee - 


* ' > * 
a ‘ -¢ 8 c 
Se. +, Scena soesns 
4, ree, S ok ene ys 2 eon 
n gue Sens ate eee RAYS CONIC ma ne» 282 
Pree roe dda So ir s : 
v 20. @@, . 






Figure 1-1. Sectional elevation of the Parseval-Airship "PL VI", 1910. 
(Marked areas are the ballonets inside the envelope) From [Ref. 1] 





Figure 1-2. Elevator controling via front and aft ballonet, (newer type). 
From [Ref . 1] 





In another fuzzy logic control model, a 15 state Kalman filter was developed to provide 
estimates of the motion variables and the applied lift and torque acting on the UUV. The control 
law decides between three possible control actions; pump water in both tanks, pump water out of 
both tanks and turn both pumps off. The fuzzy input state space is composed of depth error and 
depth rate, and each is divided into partitions. The fuzzy controller interpolates between the 
partitions allowing the control to vary smoothly as the states move from one partition to another. 
These movements of states were provided by on and off of ballast pumps [Ref. 3]. 

C. THESIS MOTIVATION AND GOALS 

The thesis will outline the development of a depth controller using sliding mode control 
techniques for a neutrally buoyant vehicle. The sliding mode controller is designed on the basis of 
the simplified four degrees of freedom vertical plane equations of motion. 

A linear quadratic regulator (LQR) proportional approach is then utilized for the design of 
the ballast controller, which produces flow rate commands, allowing the vehicle to have a soft 
grounding behavior. 

These two controllers used a logic based depth regulator to provide realistic simulation of 
the vehicle’s flight and grounding capabilities for a single mission. 

D. THESIS ORGANIZATION 

In Chapter II, the equations of motion in six degrees of fredom are reviewed simplified for 
vertical plane case [Ref. 4], which provides the basis for the depth control design. Chapter IL 
discusses the design of a flight controller with sliding mode techniques, and the development of the 
grounding controller using different methods of ballast control. Chapter IV outlines the methods 
and functions used for the simulating the designed systems. Chapter V discusses the results of the 
simulation studies which were conducted by using parameters of NPS Phoenix AUV. The 
hardware components like sensors, pumps, and tanks needed for ballast control explained in 


Chapter VI. The conclusions and recommendations can be found in Chapter VII. 
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Il. VEHICLE MODELING AND EQUATIONS OF MOTION 


A. INTRODUCTION 

For simulation of maneuvering and motion control of the vehicle, it is assumed that 
[Ref.4] : 

1. The vehicle behaves as a rigid body 

Zz. The earth’s rotation is neglected as far as acceleration components of the 
vehicle’s center of mass is concermed. 

3: The primary forces that act on the vehicle have inertial, gravitational origins and 
hydrostatic, propulsion, thruster, and hydrodynamic forces from lift and drag. 
B. DEVELOPMENT OF THE SIX DEGREES OF FREEDOM NON-LINEAR 

EQUATIONS OF MOTION FOR A MARINE VEHICLE 

The following work concerned with development of the six degrees of freedom non- 
linear equations of motion for a marine vehicle includes the equations described by Healey [Ref. 
A]. A vector X of vehicle body frame velocities and a vector Z of global positions was defined 


as: 


(2.1) 


rat 
1 
+~.0 CG 2 < & 


then considering M as a 6 x 6 mass matrix including translational and rotational inertial elements, 


the equations of motion can be written in the following vector form, 
Mx +f(x) +F, (z) =F, | (2.2) 


and, 





Z+9(x,z)=0 (2.3) 
With suitable knowledge of the excitation force and moment loads, a solution for the 
vehicle’s dynamics can be obtained. A more detailed insight into the development of these 


differential equations, in first order form given by the foregoing analysis shows, 


Xy 
m{V+Wxp,}+m(WxWwxpy + Wxv)t fo(Z=| Y; |. (2.4) 
Zs 
and, 
K; 
Lw+m{p, xv} +wx (LW) +m{p, x Wx ¥} +m, (z) =| M, (2.5) 
Ny 
It helps here to define the cross product coefficient matrix so that, 
WxBg =f x w = —[cros(h, )]W (2.6) 
where, 
0 ZG Ge 
[cros(BgI=|-z 9 = Xe 2.7) 
Yo —%@ 0 


The next step is to collect all inertial terms into a 6 x 6 mass matrix including the inertia 


cross coupling effects, 


m 0 0 0 Zx. =YVe 
Om QO m|-zZ, 0 XG 
ee 10 0 m Yo ~Xg 0 08) 
O =—Ze Ve Te. ae de 
m| Z, QO ~-X, Ie. Aig. alge 
-Y¥e Xe 0 Ts. Ay ay 


The remaining terms on the left hand side arising from centripetal and coriolis accelerations 


become, 








ft | m(w.xWX.p, +wx.v) ' aT | 


w x.(I,w)+m{p, xwx.v 


The double vector cross products are nonlinear in the primary velocity variables and 
hence the need for the nonlinear functional, f(e). The reader can perform the indicated 
manipulations to express individual equations within the set.It may also help if the screw symetric 


matrix S(e) is used in place of the vector cross product [Ref. 5].This yields, 


m(S(w).S(w).p, +S(w).v ' (2.10) 


: Weer eam ine 


The screw symetric matrix involving the vector cross product of @ with other vector is 
QO -r +q 
S@)=| r O -p (2.11) 
-q p 0 
The components of the sum of all external forces and moments acting on the vehicle 
body are separated in the above analysis into six components each acting along the vehicle body 
fixed coordinate axes and form the total vector of forces and moments as 
FOX DY AD.ZAD.KADMONOY (2.12) 
where the vector components in order refer to the surge, sway, heave forces, and the roll, pitch, 
and yaw moments respectively. The expressions for X; etc. are found as the sum of all external 
forces acting on the vehicle. 
In the component form, these external forces can be defined as follows, 
m[i + qw-m-X,(q’ +1°) + yo(pq—f) +2, (pr+q)]=X 
m[b +m —pw—yo(t’ +p°)+Z.(qr—p)+ x. (qp+H]=¥ (2.13) 
m{w + po—qu—z,(p’ +q°)+xg(tp—q) +yg(tq+p)]=Z 


where 
F = Xi+ Yj+ Zk (2.14) 
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If I is the mass matrix of inertia of the body, in component form , 
H =H,i+H,j+H,k 
and, 
H, =I,p-1,q- Ir 
H, =-I,,p+Ijq-IL,1 
Help} igqtit 
If the external moment, M , is denoted as, 
M = Ki +Mj+Nk 
and in component form, 
I,p+(, —1, qr +1, (pr-4)—I,.(q° - 1°) - 1, (Pq +7) 
+mly,(w—uq+vp)—Z,(b+ur—wp)]=K , 
1,q+(, -1,)pr +1, (art p)+1,.(pq-#) +1, (p* - 5°) 


—m[x,(w-—uq+vup)—z,(0-vr+wq)J=M , 


1,i+(, -1,)pq-L,(p’ -4°)-I,.(pr +4) + 1,, (ar —p) 
+m[x,(0+ur—- wp)-y,(u—-vur+ wq)]=N 
where, 
I, .vehicle mass moment of inertia around the x-axis 
(K,M.N) : roll, pitch, and yaw moments, respectively 
(p.q.r) —_: roll, pitch, and yaw rates, respectively 
(u,v, Ww) : surge, sway, and heave velocities, respectively 
x : body fixed axis, positive forward 
XG : longitutional position of center of gravity 


(X,Y,Z) : surge, sway, and heave forces, respectively 
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(2.15) 


(2.16) 


(2.17) 


(2.18) 


(2.19) 


(2.20) 








y : body fixed axis, positive starboard 


Yo : athwartship location of center of gravity 
Z : body fixed axis, positive down 
ZG : vertical position of center of gravity 


(>,8, y) : roll, pitch, and yaw Euler angles, respectively 

These equations are the three rotational equations of motion, and together with the 
translational equations, are the six degrees of freedom equations of motion of a rigid body 
expressed in a coordinate system moving with the body, fixed at the body’s geometric center 
[Ref. 4]. 
C. EXTERNAL FORCES AND MOMENTS 

The right-hand sides of Equations 2-13 and 2-20 may be expanded to include the sum of 
individual component forces and moments arising from hydrostatic and hydrodynamic sources 
and external forces arising from control surface deflections and propeller thrust [Ref 6]. These 


equations are expressed as follows: 


m[u — ur + wq-X,(q" +1°)+yg(pq-f)+Z,(pr+4)] =X, +Xy +X, 
m[b +ur—wq+x,(pqtt)-yoe(p’ tr’ )t+z6(qr-pJ=YytYwtYo = (2.21) 
m[W —uq+vp +X, (pr-)+ yg (qr+p)—Z6(p* +4 )J=Zy tZy +Ze 


1,p+(1, -1, ar+1, (pr-4)-1,,(q? -17)-1,.(pq+#) (2.22) 
+m[y,(w —uq+up)—z,(0+ur—wp)]=K,+K,+K, 
1,q+(1, -I,)pr—1, (qr +p)-1,,(pq—-7)-1,,(P* -1°) (2.23) 
+m[x, (Ww —uq+vup)—z, (i —urt+ wa)] =M,+My+M, 
Li+(l, -I,)pq-1L,(p* -4°)-L,(@r+4) +1. (ar-p) (2.24) 


+m[x, (0+ur—wp)-y, (u-vr—-—wq)]=N,+Ny+N, 








Hydrostatic restoring forces and moments are due to the vehicle weight W and buoyancy 
B. The net buoyancy force in the inertia system is (W-B) in the positive Z-direction (downwards). 


Therefore, in the ship fixed system, 
Xy =—(W —B)sin® 
Y,, =(W -B)cos@sin > (2.25) 
Zy, = (W -B)cos8coso 
The moments due to W and B in the component form, 


Ky =(y,W-—y,B)cos@cosd —(z, W —z,B)cos@sin > 
M,, =—(x, W —x,B)cos@cosd —(z, W —Z,B)sin® (2.26) 
Ny =(x,W-x,B)cosOsin$+(y,W —y,B)sin 9 


Forces and moments due to control surface deflections are reflected as added drag in 
surge, while in sway, heave, pitch and yaw they are directly proportional to control surface 
deflection [Ref. 6], 


Ko = (Ky5.5, + Xq5,5, qd + Kip 15, + X yg VS, + (Ko5,5, + Xu5,0,)W (2.27) 


+X556, +Xo55, +Xs55, +X,(n) 


Y¥, =¥,6,+Y,(@) (2.28) 
Z, = 25,0, +Z5,0, (2.29) 
K, = K,(n) (2.30) 
M, = M,; 6,+M;,0, 0 (2.31) 
N, = N,6, +M>(n) (2.32) 


where, 


6, = rudder deflection 
6. = stern plane deflection 


5, = bow plane deflection 
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The terms with subscript P represents the forces and moments generated by the propeller 


revolutions, n. The most significant of these forces is the propeller thrust, X (7), while Y,,K>, 
and N, represent small asymmetry effects generated by the propeller.These three terms would 
be zero for the vehicle equipped with two symmetrically loaded counter-rotating propellers. 

The hydrodynamic forces and moments are expressed as polynomial functions of the 
translational and rotational velocities of the vehicle with respect to the water by using a constant 
coefficient model, 

Xu = Xppp’ +X,,q° +X, 6 +X,,prt+ X,u+ X,,wq t+ X,,vp+X,,or (2.33) 
+X,,v° +X,,w +R(u) 

Y, = Y,p+ ¥,t+Y,,pq+ Y,qr+ Y,0+ Y,p+ Y.r+ ¥,,0q+ Y,,wpt Y,, Wr (2.34) 
+Y,0+ Y,, vw 


1 (vo + xr) 
—~—p]IC,, h(x)(v + xr)? +C,, b(x)(w - xq)’ K——~dx 

PI Io, n(x (o + x1)? + Cp, bow — xa)? FE 
Zu =Z,4+Z,p° ies alles +Z,W+Z,qt+Z,,vptZ,,ur+Z,w+Z,,v° (2.35) 


W xq) 4. 
Unt) © 


-=p | IC, h(x)(v + xr)? +C,, b(x)(w - xq)’ alee 
K, =K,p+K,r+K,pq+K,qr+K,0+K,p+K,r+K,,0q +K,,wp+K,, wr (2.36) 
+K u+K,,0w 


M, =M,q+M,,p? +M,,pr+M,1° +M,w+M,q+M,,vp+M,,ur+M,w+M,,v0° 
w-xX 
+— =P Cp hv +xr)” +C,, b(x)(w - xq)’ are m Woe (2.37) 


Ny =N,pt+N,r+N,,pq+N,qr+N,o0+N p+N.r+N,,0qg+N,,wp+N,,wr (2.38) 


\] 








+N,0+N,,,0w 


D+ xr 
alos hix)(o+x0)? + C,, bOx)(w ~xq)* OD = ees 
where R(u) represents the vehicle’s resistance curve, which is negative since positive direction Is 


ahead.The cross flow integral terms are integrated over the length of the body and they model 


quadratic drag forces.The cross flow velocity U/, is, 


= (v+ xr)? +(w ~ xq)?” (2.39) 

D. EQUATIONS OF MOTION IN VERTICAL PLANE 
We will deal with only vertical plane variables; i.e., heave, pitch, and surge.The vertical 
plane stability analysis involves heave and pitch motions -However, the surge equation couples 
into pitch and heave through the metacentric height zg. This is a dynamic coupling, and could be 


eliminated by redefining hydrodynamic coefficients with respect to the ship’s center of gravity 


instead of its geometric center. 


Restricting the motions of the vehicle to the vertical (dive) plane, the only significant 
motions that must be incorporated to model the vehicle in the dive plane are, the surge velocity 
(u), the heave velocity (w), the pitch velocity (q), the pitch angle (9) and the global depth 
position (z).This restriction simplifies the previously developed equations to a system of four 
non-linear equations of motion, which are, 


Q=q (2.40) 
(m-Z,, )w+(-mx, —Z,)q =(m+Z,)Uq+mz,q° +Z,,Uw +(W-B)cos® 


nose xq) 


rial Cyb(x wa we a dx +U?(Zs, +aZ;, )b, (2.41) 


12 











(-mx, -M, )w+, a ~mx, )Uq—-mz,wq+M,Uw+U’(M,; _+aM,, )o, 


-3e | Chb(x yada = = xq) =_—_—_xdx —(x, W —x,B)cos@-(z,W-z,B)sin@ = (2.42) 


xq| 


z=—Usin0+wcosd (2.43) 


These equations can be linearized for a level flight path when the dive plane angle is 
zero, 5,=0. By setting all the time derivatives to zero and neglecting for the moment the 


hydrodynamic drag terms, the following are obtained : 


Z,Uw+(W-B)cos8=0 - (2.44) 
M,, Uw —- (x, W — x,B) cos —(z, W —z,B)sin 8 = 0 (2.45) 
q=0 (2.46) 
—Usin8+ wceos8 =0 (2.47) 


If the vehicle is neutrally buoyant : 


Xo =p (2.48) 
W=B 
Then the Equations 2.40-2.43 are linearized as : 
§ = q (2.49) 
(m-Z,,)w+(-mx, -Z,)q=(m+Z,)Uq+Z,Uw+U°Z,6, (2.50) 


(-mx, —M,,)w+(I, -M,)q=(M, -mx, )Uq+M,,Uw -(z, —Z,)W®8 +U'M, 6. 
(2.51) 


z=—-U0+w (2.52) 
Both Zs; and Ms are a linear combination of the respective stern and bow hydrodynamic 
control surface coefficients and the respective input value of 5.This makes the system of 
equations as a multiple input system.To reduce this system into a single input system, the linear 


combination of control inputs will be modified into the following form, 
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Z,=2Z, +aZ, and M, =M,;. +aM;,, (2.53) 

This will allow a single input 6 to control both stern planes and bow planes, and will 

cause the bow planes to be slaved to the stern planes.This technique is known as dual control. The 
value of a will range from —1 to 1.The selection of the value of « will allow the planes to operate 
as desired for the particular maneuvering condition, i.e., a = 0 for no bow plane control, a = -1 
for bow plane and stern plane control opposed to each other, resulting the maximum pitch 
moment, and a = | for bow and stern plane control in the same direction, resulting the maximum 


heave force. 


These equations can be shown in matrix format as follows, 


1 0 0 oO] 6 
0 (m-Z,) —(mx,+Z,) Ow] 
0 -(mx,+M,) (QU,-M,) O14 
0 0 0 1} z 
0 0 ] 0/6} |9 
2 
0 Z,U (Z,+m)U O}w] | UZ; 5 (2.54) 
—(Zg -Z3)W M,U (, —-mx,)U O}g UM, 
—-U 1 0 O}z 0 
) 0 0 1 oj] |0 
” _| 82128 aU a,,U O|/w in ail (2.55) 
q @3Zgn, @3U aU O}q b,U 
Zz —-U 1 0 Oz 0 
where : 
Dv =(m-Z, )U, -M,)—(mx, +Z, (mx, +M,,) (2.56) 
Zon =Zg —Zp (2.57) 
mx, +Z.)W 
a.) __ {mx +2,)W (2.58) 
Dv 
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_,-M,)Z,, +(mx, +Z,)M, 


a. = 2.59 
22 Dv ( ) 
— (I, -~M,)(m+Z,)+( (mx, +Z,)(M, —mx,) 0.60) 
Dv 
—(m—Z,, )W 
a3; = a (2.61) 
ne (mx, +M, FAO SIN (2.62) 
V 


For the case considered during this work, the vehicle has also two ballast tanks which 


were designed to be used during the grounding. These ballast tanks can be seen in Figure 2-1. 





Figure 2-1. The Location of Ballast Tanks in the AUV 


The new forces are 5w, and dw; and since the ballast tanks are not located in the same distance 
from the center of gravity of the vehicle there will be also two moments, L;6w, and L,6w2, There 
will be also small change in moment of inertia. So all these changes can be listed as; 


W =W, + dw, +6w, (2.63) 


ae (Ww, +5w, +6w,) (2.64) 
g 
I, =I, +L, (6w,/g) +L," (6w, /g) (2.65) 
And the new equations of motion become, 
0=q (2.66) 
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(m—-Z, )w-—(mx, +Z,)q =(m+Z, jug +mz,q° +Z,uw+(W-B)cos0 © (2.67) 


I (w ~ xq): 2 
on =P] Cob(x) 5 —- +u Z,9, 


lw — xq| 
(-mx, -M,,)w+(I, -M,)q =(M, - mx, )uqg-mz,wq+M,,uw —-(x,W —x,B)cos® 


3 
-=p epg de —(zW —z,B)sin 0+ u’M,6, +(L,5w, —L,5w, )cos® 


lw — xq 
(2.68) 
z= —usin8+wcos8 (2.69) 
After linearization, 
O=q (2.70) 
(m-Z,,)w—(mx, +Z; 4 = (m+Z, ug +Z,uw+(W- B)-> pC; b(x POOF ou'z, = 


(2.71) 


(-mx,, —M,,)w+(, -M,)q =(M, —mx,)uq+M,,uw — (x, W —-x,B)-—(z, W —2,B)0 


-=p [Cy b(x x vax) = aD a tM, 5. +(L,éw, -L,6w, ) (2.72) 


 z=-u0+w (2.73) 


and in matrix form, 


1 0 0 0 
0 —-Z — +Z, 0 
M _ (m aw) (mx , a) (2.74) 
0 (mx, -M,) (I, -M,) 0 
0 0 0 1 
0 0 1 0 0 oOo 0 
0 Z,u  (m+Z 0 11) Zyu? 
4 B, = (2.75) 
-(z,W-z,B) M,u (M,-mx,) 0 ~L, L, M,u? 
—u ] 0 0 0 0 Q 
16 





0 
ow, 
WwW 
U =| dw, state variables = (2.76) 
q 
6, 
Z 
where ; 
x =M’™A.x+M'B,U (2.77) 
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Ill. CONTROL SYSTEM DESIGN 


Flight control and weight control compose two main subsystem of a soft grounding 
system. In flight control the vehicle is kept neutrally buoyant and the plane angles are the control 
inputs. However in weight control, the flow rates for both balast tanks are controlled with zero 
forward velocity and plane angle. These two components of the designed control system were 
explained in following sections. | 
A. FLIGHT CONTROL 

The dynamics of underwater vehicles are described by highly nonlinear systems of 
equations with uncertain coefficients and disturbances that are difficult to measure. An automatic 
controller for this kind of vehicle must satisty two conflicting requirements: First, it must be 
sophisticated enough to perform its mission in an open ocean enviroment with ever-changing 
vehicle/environment interactions. Second, it must be simple enough to achieve real-time control 
without nonessential computational delays. Sliding mode control theory yields a design that 
fulfills the above requirements. It provides accurate control of nonlinear systems despite 
unmodeled system dynamics and disturbances. Furthermore, a sliding mode controller is easy to 
design and implement. A very effective sliding mode controller can be developed from the 
linearized equations of motion for an underwater vehicle [Ref. 7]. 

The sliding mode control design problem can be stated as follows: 

Given the system; 
x =f(x)+g(x)u (3.1) 


where the state vector equation is, 


(3.2) 
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Choose the Lypunov functions : 


Vix) = [oF 3.3) 


where 
o(x)=s'x . (3.4) 
The scalar function o(x) can be viewed as a weighted sum of the errors in the states x. 
For stability, it is desired the time derivative of V(x) to be negative, 


V(x)=06 <0, (3.5) 





This can be achieved if 
66 =-7’|o| , (3.6) 
which means that 
6 =—n’sign(o) (3.7) 
Using o(x) =s'x , we get 
6 =s'x =s"f(x)+s"9(x)u =—n’sign(o) , (3.8) 


and solving for u, the control law is obtained, 
u=—[s"g(x)}'s"#(x)-[s" g(x] 'n’sign(o) . 3.9) 
In this control law, the first term is nonlinear state feedback, and the second term is a switching 
control law. The term 7” is an arbitrary positive quantity, we usually select it such that Vis 
negative even in the presence of modeling errors and disturbances. The above control law 
guarantees stability of o(x) = 0, or s'x = 0. It is necessary to find s. If o(x) = 0, the system 
becomes 
u= stax) s'f(x) , (3.10) 


and 
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& = £(x)—g(x)[s"g(x)['s™£(x) . (3.11) 
when the system is linearized, 
x = Ax + Bu (3.12) 


The previously developed linear state matrix equation is, 


1 0 0 076} |0 0 1 oo 
0 (m-Z,) -(mx,+Z,) Ow} |0 zu (m+Z,h O0]w 
0 (- mx, -M,) (,-M,) Og i. -(z, W —z,B) M,u (M, —mx, a 0 | q 
0 0 0 1 jz —u | 1 0 0 || z 
0 
Zu’ 
5 (3.13) 
M,u’ 
0 
l 0 0 0 


0 (m-Z,) -(mx,+Z,) 0 


M= (3.14) 
0 (-mx,-M,) (,-M,) 0 
0 0 0 1 
0 0 ] 0 0 
0 Z m+Z 0 Zu’ 
A. = wt (m+Z,)s B =| ° (3.15) 
~(z,W-z,B) M,u (M,-mx,) 0 M,w? 
—u 1 0 0 O- 


where W = W., since the vehicle is neutrally buoyant during the flight. The above can be written 
as, 
x = Ax+Bu (3.16) 
but the dynamics and input matrices should be replaced by 
A=M’A,,andB=M'B, (3.17) 
and the system is controlled with sliding mode controller where 
u =-(s'B)'s' Ax —(s'B) 'nsatsgn(s’x/¢) (3.18) 


21 








The closed loop dynamics matrix is 


A, = A-B(s'B)"'s'A=A-Bk (3.19) 
then 
k=(s'B)'s’'A>s'Bk=s' A=>s'A-s'Bk=0 , (3.20) 
so the control law becomes , 
u = —kx —(s'B)'nsat sgn(s*x/) (3.21) 


The gain vector k can be found easily by using Matlab. The Matlab command place accepts as | 
inputs the A and B matrices along with a vector of the desired closed loop poles and returns the 
vector k. 
B. WEIGHT CONTROL 

In the second part of the system, the balast tanks were used to ground the vehicle on the 
ocean floor. The vehicle’s grounding can be simulated by adding weight proportionally to both 
tanks at constant flow rate and by using zero plane angle (6, = 0) with those four state variables 


({8,w,q,z]') defined previously. It is needed to add weight proportionally to eliminate the 


moment effect since these balast tanks are not located in the same distance from the center of 


gravity. As it can be seen from the Figure 3-1, L) > Ly. 





Figure 3-1. The Location of Ballast Tanks 
To get zero moment, 
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bw, = ata: (3.22) 
L, 


If the ballast pumps only pump water into the tanks at fixed rate, there is no control on 
pitch or depth rate and pitch angles can develop large values. It is proposed therefore, that in 
order to keep the pitch angle within limits, flow rate of each tank should be controlled separately. 
This can be achieved by defining two more states to be added to those existing four states. And 


further these two states are, 


(3.23) 


where Sw, represents change of weight in tank i and f; represents flow rate of pump 1. So the 
nonlinear saiistions of motion become : 

a q (3.24) 
(m-Z, )w +(-mx, -Z,)q=(m+Z,)Uq+mz,q* +Z, Uw +(W -B)cos6+U*(Z, +aZ, 8, 


nose 


-3° Cb(x ye ala x0)" x 3.25) 


lw —xq 


; 1 (w —xq)° 
(-mx, —M,,)w + (I, ~M,)4=(M, - mx, )Uq -mz,wq+M,,Uw —>p [ C,b(x)5———- xdx 
tail 


wx 


-(x, W -x,B)cos0-(z, W —z,B)sin6 + U*(M;. +aM,; )5, (3.26) 


z=—Usin8+wcos@ (3.27) 
ow, =f, 

. (3.28) 
ow, =f, 


During the grounding operations, plane angles (6,) will be zero. Removing related terms, the 


new equations become, 
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0=q (3.29) 
(m-Z, )w +(-mx, —Z,)q=(m+Z,)Uq + mz,q* + Z,, Uw + (Ow, + 5w,)cosO 


nose 


ait Cyb(x) WD ax (3.30) 
Z WwW - xq 


l nose w-x 3 
(-mx, -M,,)w+(, -M,)q=(, —mx, )Uq—mz,wq+M, Uw -5P | C58) a 
tail 


—(x, W, —X,B)cos0-(z,W —z,B)sin 8+ (—L,6w, + L,6w, ) cos (3.31) 


z=—Usin@+wcos6 | (3.32) 
ow, =f, (3.33) 
ow, =f, (3.34) 
where 

Ww = W, +5w, +6w, (3.35) 


When these equations are linearized, 


1 0 0 0 0 016 

0 (m-Z,) (-mx,-Z,) 0 0 Oj @ 

0 (-mx,-M,) (,-M,) 0 0 Of4q 

0 0 0 10 Olz 

0 0 0 0 1 Of bw, 

0 0 0 0 0 1] sw, 
0 0 1 0 0 o]fe 0 0 
0 Z,u (m+Z,u 0 1 1 jo 0 0 

_|-@cW.-23B) M,u (M,-mx,)u 0 -L, L,/q . 0 ba 3.36 
-u 1 0 0 0 Ofz 0 Of, 
0 0 0 0 O Oféw,}| |1 0 
0 0 0 0 0 Oféw,} {0 1 


24 





Flow rates for balast tanks are control inputs. In the next step, the control system will be designed 
to keep the pitch angle and depth rate within the limits during grounding of the vehicle. 
C. WEIGHT CONTROL WITH LINEAR QUADRATIC REGULATOR 
The system was given as, 

x = Ax+Bu — (3.37) 
where the gain matrix K of the optimal control vector, 

u(t) = —Kx(t) (3.38) 
minimizing the performance index gives 


J= [ (x™Qx +u7Ru)dt (3.39) 


where Q is a positive-definite Hermitian matrix and R is a positive-definite Hermitian matrix. 
(u’ Ru) term accounts for the expenditure of the energy of the control signals. The matrices Q and 
R determine the relative importance of the error and the expenditure of this energy. Q is the state 
weighting matrix and R penalizes the control effort. It can be choosen relatively small elements of 
Q compared to R for the control law which will tolerate errors in x with low control effort u. 
Chosing larger elements of Q compared to R will result in tight control which means small errors 
will need considerably more control effort. The advantage of using the quadratic optimal control 
system is that the system will be stable as long as it is conrollable [Ref. 8]. 

By using the general equations of optimal control to solve the LOR problem gives the 


Hamiltonian 
H(x, p,u) = p’ (Ax + Bu)-(x"Qx +u'Ru) , (3.40) 
where p is an unknown vector (co-state vector). The necessary conditions for optimality are, 


k= Sok Ax+Bu (3.41) 
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p+ Qx (3.42) 


—=0>B'p-Ru=0>u=R"B’p (3.43) 


and the boundry conditions are, 

[p’ (t,)+x;F]6x, =0 (3.44) 
where ‘ is free, Ox, is arbitrary and F is symmetric and positive-definite weighting matrix. So, 
the quantity inside the square brackets must be equal to zero and this produces a new form of 
boundary condition, 

p(t, ) =—Fx(t;) (3.45) 
Now, the equations that have to be solved can be listed as follows, 


% = Ax +BR“B'p, 

- Ay At 

p i= Qx A Pp; (3.46) 
x(t.) =X,, 

p(t, ) = Fx(t,). 


From above equations, p(t) can be calculated and this will provide u as a function of time from 
u = R7'B’ p(t) . By using Kalman’s idea, p(t) can be defined as, 
p(t) = -S(t)x(t) (3.47) 


where S(t) is a symmetric positive-definite matrix. Also, 


p = -Sx — Sx = -Sx —-S(Ax +BR™'B’p) (3.48) 
and , 
Qx — A?p = -Sx -SAx —-SBR"B'p (3.49) 
~§Sx = (A™S+SA-SBR'B'S+Q)x (3.50) 
and for this to be true for all x, 
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-~S=A"S+SA-SBR"B'’S+Q_ (with S(t,) =F) (3.51) 
This is called Riccati matrix differential equation and S(t) can be obtained by backwards 
integration of this equation. Since u = R™'B’ p(t) the closed loop optimal control law can be 


found by 
u= RB’ Sx (3.52) 

where S can be found by solving the algebraic Riccati equation for the positive-definite S , 

A'S+SA-—SBR™'B’S+Q=0 (3.53) 

In Matlab, the command 
Iqr(A,B,QR) 

solves the continuous-time, linear, quadratic regulator problem and the associated Riccati 
equation. This command calculates the optimal feedback gain matrix K for control law which 
minimizes the performance index. 
D. | GROUNDING WITH VERTICAL THRUSTERS 

The bladed thrusters are the essential elements of improved vehicle positioning systems. 
With automatic position control, the thrusters enable important scientific and industrial tasks such 
as automatic docking, station keeping, precise surveying, inspection, sample gathering and 
manipulation. Incorporating precise models of thruster dynamics into the feedback control 
systems of marine vehicles promises improved vehicle positioning [Ref. 9]. 

Most small-to-medium sized underwater vehicles are powered by electric motors driving 
propellers mounted in ducts. The propeller is mounted in a duct or shroud in order to increase the 
static and dynamic efficiency of the thruster. Thrusters are subject to serious degradation due to 

axial and cross flow effects. Axial flow effects can be reasonably approximated by the modeling 
of the thruster unit alone, the velocity of the fluid entering the thruster shroud effectively changes 


the angle of attack of the propeller , thus altering the force produced. Cross flow effects are much 
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more difficult to model and are highly dependent on the position of the thruster on the vehicle. 
The amount of force produced by the thruster will reduce the overall gain of a control system 
unless these effects are specifically in the controller design{Ref. 10]. 

For this work, NPS Phoenix vehicle is taken as an example. Figure 3-2 shows the 
locations of vertical and horizontal thrusters on the vehicle.Those four tubes represents the 
thruster shrouds. In Figure 3-3, the vertical thruster tubes can be seen throughout the vehicle. 
Thruster blades are located close to the bottom of those tubes. 

Thruster moment and force equations were developed by Louis L.Whitcomb and Dana 
R.Yoerger [Ref. 9]. On that paper, the control system for these thrusters was also discussed. But 
in this study, these thruster force and moments were assumed as some constant parameters and 
also no control law was developed to control them. Since the main element for grounding is the 
weight control, the thrusters were just used as auxillary elements of this procedure in order to 
increase depth rate. By using thrusters in addition to the weight control, following changes 
should be done to heave and pitch rate equations, 


(m—Z,,)Ww +(-mx, -Z;)q=(m+Z,)Uq +mz,q° +Z,, Uw + (dw, +5w,)cosO 


nose = 3 
lise Sey ae (3.54) 


at ( 
=P J C,,b(x) a 


, } ™ w —xq)° 
(-mx, —M,,)w+(I, -M,)q=(M, — mx, )Uq-mz,wq+ M,, Uw =P C0) Sat 
tail 


~(x,W, —X,B)cos@ —(z, W —z,B)sin 6 + (—L,dw, + L,6w,)cosO- Maced (3.55) 


where Zirusterand Minruster are thruster force and thruster moment respectively. 
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Figure 3-2. Horizontal and Vertical Thrusters of NPS Phoenix AUV 





Figure 3-3. Vertical Thrusters and Thruster Shrouds of NPS Phoenix AUV 
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IV. SIMULATION 


For the realistic simulation of the grounding system, some other control functions were 
used in addition to the flight and weight controls. The system was simulated by using Matlab’s 
Simulink program. For the dynamic control, Matlab’s s-function was used. This tool gives us the 
opportunity to use the memory dynamically. In fact, it is nothing different than a ODE solver. In 
that block, the state equations were solved by using Matlab’s ode45 function with variable step 
SIZe. 

As depicted in Figure 4-1, two main components of control system are flight control and 


weight control, and they also form two main loops of simulation. 
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Figure 4-1. Dynamic Controller with Weight and Flight Controllers 
For the simulation of longitudinal motion, in addition to the states used in the control 
laws, X was also included. But this term was not used in control design. X was defined as, 
X =u.cos8+wsin0+U,, (4.1) 
where u is the forward speed and Ucz is current. 
The design of weight and flight controls were explained in previous chapter. Zcom is the 


commanded flight depth. The sliding mode controller calculates the control surfaces from the 
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error which is the difference between the commanded and actual depths. The switch from the 
flight control to the weight control is decided by the forward speed command produced by speed 
control unit. This unit has two parts: Speed control and secondary control units. 

The speed control block seen in Figure 4-2 reduces the forward velocity to 0.1 ft/sec 
when the vehicle reaches to the commanded flight depth. But this is not a sudden decrease in the 
speed. Since the longitudinal position was also commanded by Xcom block, the control unit 
calculates the necessary break distance in order to reach that location. The break distance was 
determined from a known deceleration in the longitudinal direction and the time needed to 
ground from the flight depth. As seen on the Figure 4-2, the input parameters to the speed control 
block are current and commanded depths, current and commanded longitudinal locations, 
commanded forward speed and ground depth; the output of the block is the controlled forward 


speed. 





Speed Contro! 


Figure 4-2. Speed Control Block 
As mentioned above, the main control input for the speed control block is the depth. 
When the depth error (Zoom — Zour) becomes smaller than a certain number, the deceleration 
procedure starts. One problem with this method is at the beginning of the grounding, the depth 


error starts to increase again which means that the speed control will increase the forward 
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velocity until it is equal to commanded speed. To prevent this, the secondary control unit seen in 


Figure 4-3 was designed: 
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Secondary Control 
Figure 4-3 Secondary Speed Control Block 

Two of the five inputs of this block are the weights in both ballast tanks. If the weight in one or 
both of those two tanks are different than zero, then the output of the secondary control becomes 
0.1 (forward speed). Otherwise, the block passes the value coming from the speed controller 
without changing. 

The speed command produced by the secondary controller provides the switch from 
flight to the grounding procedures. Figure 4-4 shows secondary control, plane angle controller 


and weight controller blocks. 


Weight Pump Flow 
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} Plane Ang. 
Plane Angle Command Angle 8 
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Figure 4-4. The Relationship of Secondary Control Block with Plane Angle and 


Weight Controller Blocks 
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When the forward velocity is reduced to 0.1 ft/sec, the weight controller starts to produce 
flow rate commands by using the methods described in Chapter III. The plane angle control block 
passes the value coming from the sliding mode controller (flight control block) without changing. 
But with the reduced speed, it makes the plane angle zero. So this ends the effect of flight control 
on the vehicle, in other words, the weight controller gets the control on the vehicle’s motion. 

Figure 4-5 shows all functions mentioned above with flight and weight controllers as a 
complete Simulink diagram. The flow chart in Figure 4-6 shows the logic of the procedure. The 


Matlab programs used in the simulation are presented in Appendix A. 
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Figure 4-5. Simulink Block Diagram Used for Simulation 
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Vv. RESULTS AND DISCUSSION 


As INTRODUCTION 

In previous chapters, the mathematical models of the control system were developed. To 
prove the validity of the flight and weight controllers, the system was simulated by using the 
parameters of NPS Phoenix AUV. These parameters are presented in Appendix B. First the AUV 
was controlled by flight controller (sliding mode control) during its diving from surface to a 
commanded flight depth. Second, the flight controller and the different cases of weight controller 
were simulated on the vehicle. 
B. FLIGHT CONTROL 

In the NPS Phoenix vehicle , there are four vertical control planes powered by servo 
motors. Using the definitions in Chapter II and Chapter III with the parameters of NPS Phoenix 


AUV and a nominal speed of 4 ft/sec, A and B matrices becomes 


0 0 ] 0 0 
_ 0.0155 -—3.4119 -—0.9247 0 a — 0.7139 (6.1) 
~|-0.1086 0.6027 -0.9667 0 ~ 0.0123 | 
—4 1 0 0 0 
By choosing the poles as p = [-2, -2.1, -2.2, 0], the vector k was calculated, 
k = place(A,B, [-2, -2.1, -2.2, 0]) (5.2) 
k = [-18.3998 , -2.4217 , -15.6369 , 0] (5.3) 
Ac is calculated from 
Ac = A- Bk (5.4) 
0 0 ] 0 
7 - 13.1205 -5.1408 -12.0882 0 65.5) 
©} -0.3352 0.5729 -1.1592 0 
-4.0 ] 0 0 
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The eigenvector of A’. for the pole at the origin is the sliding surface 


s = [-0.8733 ; -0.0272 ; -0.4692 ; 0.1287] (5.6) 


as a result with @ = 0.1 , the control law becomes 


§ = -18.39980 — 2.4217 -15.6319q 
~ (0.4)sat sgn {— 0.87330 — 0.02720 — 0.4692q + 0.1287(Z — Zcom) ois = 6.7) 


The motion of the vehicle is restricted to the vertical plane. The motion profiles for depth 
and pitch have been specified using sliding mode control. For the maneuver, the commanded 
depth was 4 ft and the vehicle was originally at the surface. As can be seen from the Figure 5-1, 
during the flight, maximum pitch angle becomes 0.042 rad (~ 2.5 degrees). When the vehicle 
reaches to the commanded depth as seen in Figure 5-2, the pitch angle becomes zero as expected . 
The controller produces the dive plane angle command according to the depth error. In the 
beginning the depth error is large, so the system produces higher values of plane angle command 
in order to eliminate this error. With the full state feedback, the vehicle responded very well to 
these commands. 

c. ADDING WEIGHT TO BOTH TANKS WITHOUT CONTROL 

After completion of the flight to the commanded depth, the vehicle gets water to both 
tanks in order to become heavy. Figure 5-3 shows the weight increase in the tanks. During 
grounding, the planes kept at zero degrees as depicted in Figure 5-4. To keep depth rate within 
limits, the maximum weight pumped in was limited at 5 Ib for each tank. With this additional 
weight, the vehicle sat on the ground (10 ft.) with 0.6 ft/sec depth rate. Eventhough the weight 


was added proportionally (Sw, = (L, /L,, dw, ) to get zero momentum effect, there is still some 


momentum because of the vehicle itself. This momentum was created by the pitch and heave 
motion of the vehicle. As a result, the pitch angle increases since there is no control on either 


depth rate or pitch angle. As seen on Figure 5-5 and Figure 5-6, at the end of a 6 ft. drop, the pitch 
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angle becomes 0.6 rad. (35 degrees). This method can be used for very short grounding depths (2- 


3 ft), but for other cases, it is not recommended since the system is completely unstable. 


Pitch angle vs time 


3 


i 
i § 
: : 
Le rier hates tehdhentetdetentdhtehdheoanhbeidindhe-ttebeientaiaahdthiateminealiadadaide 
i i 
3 


3 
3 


' ‘ : ' ‘ 

3 7 i : H 
uann.ns 60609 94 anmee x peer cortenire sma 6 1 +004 500 9004 oe ROT nH cirirtnnt anes ROSeRLe SO ORE CMP mNyE mii too EDEEEN hers =o mna heh COTES COOh ero 

r . 5 3 

$ : H 3 


F 
i 






! H 
t 4 
Gata cme ce esae nenemer re ngeny whats: aeamacssaneey 
M H 


‘ 
caschassonenssue ss season mann sues 


/ 


a 
t7he med means Peeeeomaas teewan 


; : : 
Aeestesmesesteereremmeyioneen tig etsnmanannan 


40 


i 
i 
t 


t 
: 
: 
2 doe eras orem mene rmre ta 
: 
z 
: 


i 


35 
ight 


: H 
; | 
j 

1 t 
| 09 ea Ow cor ioe 
{ i 
i i 
t j 
; j 
i i 
i i 


. 3 
CEP PDeedenarnne ro@ sb-r0 He O60 eat toes ahs on roesnee sees 
: . 


The Fl 


j 
25 
ing 
os Semernrenreneten 


3 
i 


| 
| 
| 
| 
; 
| 
| 
| 
| 
mm 
| 
ate ian 





i : 
Hi 3 
f H i ; 
— gare nies revo connens neeiay same emer 14 Dimon Sabet HORRORS rune gu acem ram mmm mt mpinrs Aoeeoe 4 aenaemnnmen 
* 3 z 
5 i Hy 
} 


vi 


i 
F 
: 
H 
: 


H 2 

: : i 

: Hy 
sogenemtcmetatcressoneanes ree emmmntmiareotmanes ate sessracessediennstamermnsme ameente 

: 

3 3 


Time (sec) 
Depth vs time 


Arey ee cnena en anan eemyere sae me 
owe newreceere sercens pemamidubadrveinesun cones seems: 
ry 3 
: i 


é 


itch Angle Plot Dur 


senes pees ere ment 
i 
£ 
H 
reverwene iy os vena cman an anew 
: H 
0 mee trident dh tb Tar ata soccer ene setveradaascessantes se shaaater siuleniemeemanenananaell eZ enaecanecamyrommemme rare i et es es conan rere 
= z = t 
4 i 4 : 
2 
t 


svecoeetrennsodp re ipa sanemevees 


P 


° 


1 


5 
Hy 
t 
: z 
: : 
: 3 
: : 
eT eee meeey See 
i z 
3 


7 
5 
S- 


i i 
i t z 
; i i H 
EEL DORON PROS NOR SN SerenieniNeTy Sires, lamest eater 
: z ’ 
H : 
2 
1 





* 
z 
> ‘ = 

ee a A GEE OEE TP ee hah gaia tah OEE OF FP TY +e Mh stem mh OED > HO OO BOER 
: : 
3 : 


: 
i 
| 
i 
| 
| 
| 


i 7) 
ten 
ee Sp 


Prt 


* 
H ! 

i200 0 60 FFU | ete emires tate dS OMA FDO B POTS eve oH demininie 1 wie 46: 
: : 


o 


: H : 
i H z i H 3 : 

a ht meee oo e088 POSSE Gran ene e mS home ats see yaoi emes anaes mintmned ECR OD Seer POM ean ance meee mben messes Hone cers pe tans nemremmienite fy Hv bhi toned MEE MRO N pS mr RatwEEte+¢ete tunel sane Gee none mea menirawerey re et 
° ’ : H , H : ¢ 
H z 3 $ : 3 : 
H 3 : i 


i 
i 
¢ 
{ 
ten ase Sr enee rane nee bas: 
f 
! 


nae mean ems eememnee rene een ceemnenm 
i 
t 
i 
i 
ad 
3 
3 
3 
i 
oaponcesaocanc rem eamodhwooenee Pmt Se a | 
i 


0 
F 


| 

| 
0.02 | a 
025 z 


-0.01 


< gS 8 8 3 
¢ s 7 § 2 & a 

. oa) 
Cpey) o[suy youd Qy) wdoq 


3 
: H 

mee eeensoseveensseme mes fann mene nd mee mins kies ies nnegs yangaamnsamss ann «am Gubi-tn rite seins Men oes on aoe eee: 
. ; 


Ne edad eer ene rates 


3 . 

: : 
wap a rennet snes ores notes Hen Gee ens me meme wit 1068 

: : 

i 

H 


3 
ri 


i 
: 


3 
i 


Lo | a) wot 
= 


z 
H 


z 
: 
: 
H 
H 


i 


: ; 

mm ereerieetewena eee nen semanresnetensteuentsnavanees revenee isons im mtmataiueaeernst eee eenseer teem none mne i hid osnensnee myn me 
: ; = ; 
; ; 


3 


f 
‘ 
evenemmcm vtmmesanenne 
= 
= 


. 
: : 
ate oth conae enon eco nen yapee named mere me wey idrit HONS Ba 
: * 
: 
I 





i 3 
} § 
i 


z 
i 
s 
z 
t 
= 
i 


; 

i : 
i 3 

srvermqrvemmeressnastnoesesesorasromoreruarssficseeseaneuns srnssammenenfcenemmatmes 
: 


4 . ry : 
joa ronesane Col f= Oe poe nrasestee Honp recsens woeesa tere efr sons anaes roceeal thos oooensnanuee 
: * = ey 


3 
3 

ol mm ot canenmne name diet mene nom vem nee 
3 
: 
5 
3 


15-20 25 30 35 40 
Time (sec) 


10 


Figure 5-2. Depth Change As A Function Of Time During The Flight. 
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Weight in balast tank vs time 
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Figure 5-3. Weight Addition During Grounding With No Control On Flow Rates 


Plane angle vs time 
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D. WEIGHT CONTROL WITH LINEAR QUADRATIC REGULATOR 

In order to keep the depth rate and pitch angle within limits, the linear quadratic regulator 
technique was used in designing a weight control. The mathematical model for this control 
system was previously explained in Chapter III. The parameters of NPS Phoenix vehicle was 
used for simulation. With these known parameters and 0.1 ft/sec forward velocity, A and B 


matrices become, 


0 0 1 0 0 0 0 0 

0.0155  -—0.0853 -—0.0231 0 0.0223 0.0196 0 0 
ase 0.1086 0.0151 -—0.0242 0 -—0.0130 0.0065 7 0 0 (5.8) 

—0.1 I 0 0 0 0 0 0 

0 0 0 0 0 0 1 0 

0 0 0 0 0 0 0 1 


In practice, high values of pitch angle (> 15 degrees) are not desired for a safe and stable 
grounding of the vehicle. So the designed control law should not tolerate too much oscillations of 
pitch angle. This kind of control law can be provided by choosing larger elements of Q for pitch 


angle compared with the others. So, Q and R matrices were chosen as follows: 


10* 00 0 00 
0 10 0 0 0 
0 01 0 0 0 
= 5.9 
° 0 0 0 10° 0 0 i 
0 00 0 1 0 
0 00 0 0 1 
3x10" (iO 
R= 5.10 
0 3x - li 
By using lqr command in Matlab, control gain matrix K can be obtained, 
[K.s,m]=Iqr(A,B,Q,R) (5.11) 


and with the numbers provided , 


42 








_ 0.0608 0.1263 -0.0526 0.0138 0.0754 0.0365 (5.12) 
~ |~0.0322 0.1294 0.0021 0.0120 0.0365 0.0613 
Since grounding to the ocean floor from a certain depth desired, the command matrix should be 


Xcom = [0 0 0 z,, 0 O]’ where z,, = (ground depth) - (the depth where grounding is started). So the 


control law becomes , 


U = -KXenor (5.13) 
where 
Xerror = X = Xcom | (5.14) 
The simulation of the system with this control law can be seen in Figure 5-7 through 
Figure 5-14. 


Positive flow rate represents water inlet to the balast tanks, and negative flow represents 
the opposite. The pumps are not allowed to pump out when there is no waite in balast tanks. 
Figure 5-7 and Figure 5-8 show when the weight in a balast tank and the pump flow rate become 
zero. This is provided by a simple controller which compares the weight in ballast tank (Ow) and 
flow rate (f). If Sw is equal to zero and flow rate is a negative number, than the control input (f) 
of that pump becomes zero. 

At the commanded depth, the speed control unit slows down the vehicle to an almost zero 
forward velocity (u = 0.1 ft/sec). The speed control unit’s other duty is to control the longitudinal 
position. During the flight, the speed control unit compares the vehicle’s location (x) with 
commanded location (X.om) Which is a longitutional distance from the original position. When the 
vehicle is at the commanded depth of flight, a deceleration procedure starts. A simple algorithm 
was used to calculate the minimum distance needed for deccaleration to reach the commanded 
location at the end of the grounding. The change of forward velocity due to the depth change can 


be seen in the Figure 5-13. 
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The depth rate as seen in Figure 5-11 is very low in this method because of the command 
given to the weight control. The weight control produces its control values due to the errors 
which are the differences between the commanded and the actual states. In the above case, only 
the depth (z) command has a value, the commands for other states are zero. At the end of the 
simuation, the pitch angle becomes almost zero as seen in Figure 5-12. In the first half of the 
grounding, Figure 5-9 and Figure 5-10 shows an increase in weight for both tanks, but in the 
second half, the system tries to make the vehicle neutrally buoyant as expected. 

E. LQR WITH POSITIVE WEIGHT COMMAND 

So when the vehicle reaches the ground, there will be almost no water in balast tanks. But 
for the stability of the grounding, the vehicle should be heavier. For this reason, in addition to the 
depth command, the weight can also be commanded to increase the depth rate or the weight of the 
vehicle at the end of the grounding. So, the command vector, Xcom is changed to , 

Xcom = [0,0,0, Zround , OWeomt » SWeom2]’ (5.15) 
where 5W.om are some positive numbers and represent the command for additional weight and the 
‘system was simulated with these new parameters. Figure 5-15 through Figure 5-20 show the plot 
of this simulation. In this case, pitch angle reaches a maximum value of 0.18 rad (10.31 degrees) 
which is 4 times greater than the previous simulation. With increasing pitch angle, there 1s also an 
increase in the depth rate. The depth rate becomes 0.35 ft/sec which is again almost 4 times 
greater than the previous simulation. Since the commanded depth for the control law is the depth 
of the ground, the system tries to make the vehicle neutrally stable to keep the vehicle on that 
depth by pumping water out of balast tanks. After grounding, pumps should pump water in balast 
tanks until they are full. Because this additional weight is needed to keep the vehicle sitting on the 


ground against the current. 


44 








Another method for increasing the depth rate is to command with a depth value which is 


greater than the actual ground depth. Because in the beginning the error will be higher, the weight 


controller will produce higher values of flow rate. 
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Flow rate of pump-1 vs time 


j 

. 

+4 
seorereaeswancaveteseesosed- ay 

j 

H 

4 


0.08 


I 


Porro ore 


sbiceemikeuienhad potobesontemineceas tenements 
: 


(9es/qq) [dun 


© 


Hy « : 
eueuncown but avateo goes nenpaiaetvors sceeeribe trenteivers opt treratenys rows rests een] cormrvese arte eer nets 
. . : 


d 10j aye) MOT 





Time - sec 


ith Depth Command Only 


1W 


For Pump 


ime 


ion Of T 


Figure 5-7. Flow Rate As A Funct 


-2 vs time 


Flow rate for pump 


« « * . 
orounen ornanisavonsarensemeandfosnsnmnsseessate Becennosantessese ere Perey 
. = 


i 


i 
i : i 
edo eine nent nena sene eso vomn seen dhs mare mers eeacouseanens ewe ceta rire seems 
2 7 7 3 
} i i 3 


? 
i 
i 
he 
: 
i 
t 
i 
jn 
; 
z 
H 





20 30 40 #50 60 ##70 #=%§go0 90 100 110 
Time - sec 


10 


Figure 5-8. Flow Rate As A Function Of Time For Pump-2 With Depth Command Only 
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Weight in tank-1 vs time 
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Figure 5-9. Weight Change In Ballast Tank-1 With Depth Command Only 
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Figure 5-10. Weight Change In Ballast Tank-2 With Depth Command Only 
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Figure 5-11. Depth Change During Flight And Grounding 
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Figure 5-12. Pitch Angle Change With Depth Command Only 
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Change in depth and forward velocity 
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Figure 5-13. Comparison Of Depth And Forward Velocity Change 
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Figure 5-14, Response Of The Vehicle To The Longitudinal Position Command 
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Flow rate for pump -1 vs time 
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Figure 5-15. Flow Rate For Pump-1 With Weight And Depth Commands 


Flow rate for pump -2 vs time 
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Figure 5-16. Flow Rate For Pump-2 With Weight And Depth Commands 
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Figure 5-17. Weight Change In Ballast Tank-1 With Depth And Weight Commands 
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Figure 5-18. Weight Change In Ballast Tank-2 With Depth And Weight Commands 
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Depth vs time 
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Figure 5-19. Depth Change With Weight And Depth Commands 
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Figure 5-20. Pitch Angle As A Function Of Time With Weight And Depth Commands 
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F. GROUNDING WITH THRUSTERS IN ADDITION TO WEIGHT CONTROL 

NPS Phoenix AUV’s cross-body thrusters consist of a 3 in. ID aluminum tube with a 
centrally located 4 blade brass propeller. A spur gear is mounted around a 3 in. diameter propeller 
and driven by a pinion connected to a 24 Vdc motor giving a 2.5:1 gear reduction. The twist of 
the propeller blade is symmetric enabling bi-directional operation delivering approximately 1.0 
pound of bollard pull force in either direction [Ref. 11]. The system was simulated with the new 
state equations described in Chapter III and the same weight control conditions defined in section 
C of this chapter. Figure 5-21 through Figure 5-26 show the result of this simulation. The depth 
rate becomes 0.5 ft/sec and the pitch angle reaches a higher value since there is no control on 
thrusters. Because the thrusters are dominant in this case, the weight controller losses most of its 
effect on pitch control. 

G. BOTTOM STABILITY 

The ground also affects the vehicle closing to the bottom. The theory explained by 
Hoerner and Borst [Ref. 12], predicts that roughly below C, =1.5 (C, represents lift coefficient), 
lift will be increased in proximity of the ground. Eventhough no experimental data is provided for 
NPS Phoenix AUV, it can be assumed that lift coefficient will be less than 1.5. For study of the 
bottom stability, two different cases of grounding were considered. Figure 5-27 shows these two 
cases. 

In the case that the vehicle’s stern touched to the bottom first, the lift will decrease the | 
weight and inrease the angle of attack. This reduces the stability and makes grounding more = 
difficult. But this feature can be very helpful when leaving the ground. In the other case, the bow 
of the vehicle touches the ground first. This time lift makes the vehicle heavier and decreases the 
angle of attack providing more stable grounding. After the completion of grounding process, the 
vehicle sits on the bottom with no lift since the lift coefficient, C; is assumed zero because of the 


symmetric shape of the NPS Phoenix AUV. Figure 5-28 shows the ocean current that the vehicle 
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can stand with different ballast weights sitting on soil with 0.7 friction coefficient. When both 


ballast tanks are filled with water completely (~23.4 lb water in each tank), the vehicle can keep 


its position against 1.52 m/sec (~3 knots) of current. 


Flow rate for pump-1 vs time 
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Figure 5-21. Flow Rate For Pump-1 With Thrusters And Weight Control 


Flow rate for pump-2 vs time 
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Figure 5-22. Flow Rate For Pump-2 With Thrusters And Weight Control 
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Weight in tank-1 vs time 
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Figure 5-23. Weight Change In Ballast Tank-1 With Thrusters And Weight Control 
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Figure 5-24. Weight Change In Ballast Tank-2 With Thrusters And Weight Control 
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Figure 5-25. Pitch Angle As A Function Of Time With Thrusters And Weight Control 
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Figure 5-26. Depth Change During Flight And Grounding With Thrusters And Wt. Cont. 
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Figure 5-27. Forces Acting On The Vehicle In Two Cases Of Grounding 
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Figure 5-28. The Current That Vehicle Can Keep Its Position 
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VI. PROPOSED HARDWARE IMPLEMENTATION 


For NPS Phoenix Vehicle, a full description of all sensors and other hardware 
components which were present on the vehicle were given by Marco [Ref. 11]. It covers the | 
gyroscopes, speed sensor, short baseline navigation system and GPS components. These 
components are used to sense vehicle roll, pitch and heading angular positions, depth, forward 
speed and location in global coordinates. Two open screws located at the stern, two vertical and 
two lateral cross-body thrusters, eight control surfaces (four rudders and four vertical planes) 
control these states. In the new design with dynamic ballast control, two tanks (bow and stern), 
two water pumps, and two flow meters as sensors were added to the vehicle. Those tanks and 


pumps were already shown on Figure 3-1. More detailed design can be seen on Figure 6-1. 
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Figure 6-1. Hardware Components For Ballast Control System 
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The pump provides one way continuous water delivery with its positive displacement, 3 
chamber diaphragm. Its maximum capacity is 1.75 gpm with 12 nominal de voltage. Since the 
pump works only one way, a four connection, three position, spring centered, selonoid-control 
valve is used to change the flow direction. By simply changing the position of the valve, the same 
pump can be used to pump water both in and out of the ballast tank. 

Flow nies will be used as sensors to provide flow rate information to the control 
system. Flow rate will be calculated from the pressure difference between the two ends of the 


meter and this analog data will be converted to digital one in A/D converter in order to be used in 


the main computer of the vehicle. 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

e A method for modeling and simulation of a soft grounding system for an underwater 
vehicle has been developed and presented. This study outlined three different sections of that 
system, flight control, weight control and bottom stability. 

e The critical parameters are pitch angle, depth rate and pump flow rate. The limitations 
of these parameters relative to the new NPS AUV have been determined and a feasible design has 
been validated by simulation. 

e An LQR state feedback control provided sufficient weight keeping to maintain the 
vehicle pitch angle within the limits, but the depth change rate is limited. For a higher depth rate, 
the vertical thrusters should be used in addition to the weight control. This uses more energy, 
however, which may be unacceptable in practice. 

e In ocean currents, the bottom stability depends on vehicle’s direction and angle of 
attack. For stable grounding, the vehicle would commanded to face the opposite direction of the 
current. Bottom conditions are highly variable, but an estimate indicates that stability for currents 
less than 1 knot may be possible. 

B. RECOMMENDATIONS 

The most important recommendation and the next step should be to perform experiments 
in Monterey Bay with added weight in the vehicle. With the Sontek ADV velocimeter to measure 
water velocity, these experiments will determine weight requirements for bottom stability in 


typical ocean conditions. 
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APPENDIX A 
The matlab programs used to simulate the dynamic behavior of the NPS Phoenix are 
given in this appendix 
MATLAB PROGRAMS 
% 
% denemel.m is the main function of the dynamic system. It defines the parameters, variables 
and 


% state vectors 





ee 
function [sys,x0,str,ts] = deneme1(t,x,u,flag) 
global rho Zqdot Zwdot Mqdot Mwdot Wo g Iyo L 


% The parameters used for the simulation 
% The physical parameters of the vehicle 
L =94.0/12.0; 

Li = 24.25/12.0; 

L2 = 14.75/12.0; 

Wo = 435.0; 

g =32.174; 

Bu = Wo; 

Iyo = 42.0; 

rho = 1.94; 

xG =0.0; 

xB =xG; 

ZG =0.5/12.0; 

ZB = 0.0; 

ZGB = ZG - ZB; 


% The hydrodynamic coefficients 
Zqdot = -0.00253*2756.81; 
Zwdot = -0.09340*377.67; 

Zq =-0.07013*377.67; 

Zw =-0.78440*51.72; 
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Zds =-0.02110*51.72; 

Zdb ~=-0.02110*51.72; 
Madot = -0.00625*20137.50; 
Mwdot = -0.00253*2756.81; 
Mq =-0.01530*2756.81; 
Mw = 0.05122*377.67; 
Mds = -1.7664; 

1.3260; 


< 
S 
T 


% The bow and stern plane relations 
a=]; 

ZGB = ZG - ZB; 

Zd = (Zds + a*Zdb); 

Md = (Mds + a*Mdb); 


°% A and B matrices were used to pass values to the other functions of dynamic system. 

A=[0 0 1000 0;Bu xG xB ZB 0 0 0;1 Zw Zq 1000; ZG Mw Mq1000;1100000; 
0000000;000000 0]; 

B=[0 0 0;1 1 Zd;L1 L2 Md;0 0 0;0 0 0;0 0 0;0 0 0]; 


% Since the system is full state feedback, C is a diagonal matrix 
C=[1 00000 0:0 100000;0010000;0001000;0000100;0000010;0000001); 


D=zeros(7,5); 


switch flag, 
% Dispatch the flag. The switch function controls the calls to S-function routines at each 


simulation stage 


% Initialization 

% sys is a generic return argument ; x0 is the initial state values ; str is provided only for 
consistency % with the S-function API for block diagrams ; ts is a two column matrix containing 
the sample times % and offsets of states associated with the block 


case 0 
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[sys,x0,str,ts] = mdlInitializeSizes(A,B,C,D); 


% Calculate derivatives 

% t is the time ; x is the state vector ; u is the input vector 
case | 

sys = mdlDerivatives(t,x,u,A,B,C,D); 


_ % Calculate outputs 
case 3 
sys = mdlOutputs(t,x,u,A,B,C,D); 


% Nothing is defined for calculation of next sample hit, updating discrete states and ending the 
% simulation tasks 

case {2,4,9} 

sys = []; 


otherwise 
error(['Unhandled flag =',num2str(flag)]); 
end 


% end denemel 


% 
% mdllnitializeSizes 


% Return the sizes, initial conditions, and sample times for the S-function 





 —O 


function [sys,x0,str,ts] = mdIInitializeSizes(A,B,C,D) 


% Call simsizes for a sizes structure, fill it in, and convert it to a sizes array 


sizes = simsizes; 


% Number of continuous states 


sizes. NumContStates = 7; 
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% Number of dicrete states 
sizes. NumDiscStates = 0; 


% Number of outputs 


sizes. NumOutputs = 7; 


% Number of inputs 
sizes NumInputs =5; 


% Flag for direct feedthrough 
sizes.DirFeedthrough= 0; 


% Number of sample times 


sizes. NumSampleTimes= 1; 


% The following statement passes the information in the sizes structure to sys, a vector that holds 
the % information for use by simulink 


sys = simsizes(sizes); 


% Initialize the initial conditions 
x0 =(0000000]; 


% str is an empty matrix 


str = |]; 


% Because the system is continuous, ts and its offset becomes 0. 
ts = [0 0}; 
% end mdlInitializeSizes 





% 
% mdlDerivatives 


% Return the sizes, initial conditions, and sample times for the S-function 


SSS 
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function sys = mdlDerivatives(t,x,u,A,B,C,D) 
global rho Zqdot Zwdot Mqdot Mwdot Wo g Iyo L 


% Plane angle 
dr = u(3); 


% Current 


Ucz = u(5); 


% Velocity 
v = u(4); 


% State Variables 
theta = x(]); 

w = x(2); 

q = x(3); 

z = x(4); 

Xs = x(5); 

dl = x(6); 

d2 = x(7); 


Bu=A(2); ZG=A(4); xG=A(9); Zw=A(10); 

Mw=A(11); xB=A(16); Zq=A(17); Mq=A(18); ZB=A(23); 
Zd=B(16); Md=B(17); 

L1=B(3); L2=B(10); 


% 
% This part will be used only when the system is simulated with thrusters. 
Zheave = 0;Mthrust = 0; 
if abs(u(1)) > 0; 

Zheave = 2;Mthrust = 38.63; 





end; 


% ii i a ce a en rr 
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% Weight, mass , and moment of inertia 
W =Wo+dl + d2; 

m = W/g; 

ly = Iyo + dl/g*(L1“2) + d2/g*(L2%2); 


% M Matrix 
Mo = [1 00000 0;0 (m-Zwdot) (-m*xG-Zqdot) 0 0 0 0;0 (-m*xG-Mwdot) (Iy-Madot) 0 0 0 0; 
0001000;0000100;0000010;000000 1]; 
a 
% This function calculates drag force and drag moment 
[Mdrag,Zdrag] = Mdrag(x); 
% 
% Equations of motion v represents forw.spd. since u is used for pump flowrate 
fl = q; 
f2 = (m+Zq)*v*q + m*ZG*(q*2) + Zw*v*w + (W-Bu)*cos(theta) +(v*2)*Zd*dr - Zdrag + 
Zheave; 
f3 = (Mq-m*xG)*v*q - m*ZG*w*q + Mw*v*w - (xG*Wo-xB*Bu)*cos(theta) ... 
- (ZG*W-ZB*Bu)*sin(theta) + (v“2)*Md*dr +(-L1*d] + L2*d2)*cos(theta) - Mdrag- 
Mthrust*q; 
f4 = -v*sin(theta) + w*cos(theta); 
f5 = v*cos(theta) + w*sin(theta) + Ucz; 
f6=u(1); 
f7=u(2); 


sys = inv(Mo)* [fl ;f2;f3; 4:5 ;f6;£7]; 


% end mdlDerivatives 


——— 
% mdlOutputs 

% Return the derivatives for the continuous states 
% 
function sys = mdlOutputs(t,x,u,A,B,C,D) 
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sys = C*x + D*u; 


% end mdlOutputs 


—————eeeee————E——— = eee 





% Mdrag 


% Makes calculations for drag terms in the equations of motion 
% 
function [Mdrag,Zdrag] = Mdrag(x); 

global rho Zqdot Zwdot Mqdot Mwdot Wo g Iyo L 
CD = 1.2; 





% Beam and length definitions for trapaziodal rule 
xL=[0.0,-43.9/12.0,-39.2/12.0,-35.2/12.0,-31.2/12.0,-27.2/12.0,- 
0.0/12.0,0.0/12.0,10.0/12.0,26.8/12.0, 
32.0/12.0,37.8/12.0,40.8/12.0,42.3/12.0,43.3/12.0,43.7/12.0]; 
xl =xL+L/2; 


bm=[0.0,16.5/12.0,16.5/12.0,16.5/12.0, 16.5/12.0,16.5/12.0,16.5/12.0,16.5/12.0, 16.5/12.0,16.5/ 
12.0,15.5/12.0,12.4/12.0,9.5/12.0,7.0/12.0,4.0/12.0,0.0/12.0]; 


X2 = x(2); 
X3 = x(3); 


if X2 == 0, 
X2 = le-5; 


end; 


if X3 == 0, 
X3 = le-5; 


end; 


Zval = bm.*((X2-xL.*X3).13)./(abs(X2-xL.*X3)); 
Mval = bm. *(((X2-xL.*X3).*3).*xL)./(abs(X2-xL.*X3)): 


67 





ZDragval=0; 
MDragval=0; 


% Trapaziodal integration 

for n=1:length(xL)-1, 
Zdragval=0.5*(Zval(n)+Zval(n+1))*(xL(n+1)-xL(n)); 
Mdragval=0.5*(Mval(n)+Mval(n+1))*(xL(n+1)-xL(n)); 
ZDragval=ZDragval+Zdragval; 
MDragval=MDragval+Mdragval; 


end; 


Zdrag=(0.5)*rho* CD*ZDragval: 
Mdrag=(0.5)*rho*CD*MDragval; 
% end Mdrag 





SS ————————— 
% smcont | 
% Makes calculations for flight controller using sliding mode techniques 

% —oeeeaoaQqQaQQqquaQaaaaaeeee eS SS SSS SSS SS 


function plane_ang = smcont(u) 





% State variable ; theta, w, q, z 
x = u(1:4); 

% Commanded flight depth 
zcom = u(5); 

% Forward speed 


v=4; 


% Matrices of linear equations of motion 

Mo = [1 0 0 0;0 (m-Zwdot) (-m*xG-Zqdot) 0;0 (-m*xG-Mwdot) (Iy-Mqdot) 0;0 0 0 1]; 
Ao=[0 0 1 0;0 Zw*v (m+Zq)*v 0;-(ZG*W-ZB*Bu) Mw*v (Mq-m*xG)*v 0;-v 1 0 0]; 
Bo=[0;Zd*(v*2);Md*(v“2);0]: | 


A= inv(Mo)*Ao; 
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B = inv(Mo)*Bo; 


% Pole placement 
pp = [-2,-2.1,-2.2,0]; 
kk = place(A,B,pp); 
Ac = A-B*kk; 


[mm,nn] = eig(Ac’); 
ss = mm(:,4); 
xcom = [0;0;0;zcom]; 


sig = ss'*(x-xcom); 
phi = 0.1; 
Nmax = 2; 


eta = Nmax*0.4/inv((ss'*B)); 


% Control law 
plane_ang = -kk*x-Nmax*0.4*sign(inv((ss'*B))) *tanh((sig/phi)); 


% end smcont 





% SS 
% |q 
% Calculates gains for weight controller using LQR techniques 





ee EEe———————————————————————————— 
% Forward speed 
v=0.1; 


% Matrices of linear equations of motion 

Mo = [1 00 0 0 0;0 (m-Zwdot) (-m*xG-Zqdot) 0 0 0;0 (-m*xG-Mwdot) (Iy-Mqdot) 0 0 0; 
000100;000010;00000 1); 

Ao=[0,0,1,0,0,0;0,Zw*v,(m+Zq)*v,0, 1, 1;-(ZG*W-ZB*Bu),Mw*v,(Mq-m*xG)*v,0,-L1,L2; 
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“Vv, 1,0,0,0,0;0,0,0,0,0,0;0,0,0,0,0,0]; 
Bo=[0,0;0,0;0,0;0,0; 1,0;0, 1]; 


A = inv(Mo)*Ao; 
B = inv(Mo)*Bo; 


Q = eye(6); 
Q(1)=10000; 
Q(22)=100; 


R = 300000*eye(2); 
[k,s,m]=Iqr(A,B,Q,R); 
k 

% end lar 





% weightcont 


% Calculates the flow rates for each ballast pump 








lS 


function wcur = weightcont(u) 


% state variables 
x= u(1:6); 


% forward speed 
v=u(7); 


% ground depth 
zer = 10; 


xc = [0 0 0 zgr 0 0)’; 


X€IT = X - XC; 
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% Matrices for linear equations of motion 
Mo = [1 00 0 0 0;0 (m-Zwdot) (-m*xG-Zqdot) 0 0 0;0 (-m*xG-Mwdot) (Iy-Mqdot) 0 0 0; 
000100;000010;00000 1); 


Ao = [0,0,1,0,0,0;0,Zw*v,(m+Zq)*v,0, 1, 1;-(ZG*W-ZB*Bu),Mw*v,(Mq-m*xG)*v,0,-L1,L2; 
“V, 1,0,0,0,0;0,0,0,0,0,0;0,0,0,0,0,0]; 


Bo=[0,0;0,0;0,0;0,0;1,0;0, 1]; 


A = inv(Mo)* Ao; 
B = inv(Mo)*Bo; 


% Checks if the grounding procedure started 
ifv> 0.1; 
weur = [0;0]; 
else 
% Gains found in lq function 
K1 =[0.0608 0.1263 -0.0526 0.0138 0.0754 0.0365]; 
K2 = [-0.0322 0.1294 0.0021 0.0120 0.0365 0.0613]; 


% Flow rate for pump-1 
weur(1) = -K1*xerr; 
% If there is no water in ballast tank-1 and flow rate for pump-1 is negative, then turns off the 


pump 

if (u(5) <= 0 & weur(1) < 0); 
weur(1) = 0; 

end; 


% Flow rate for pump-2 

weur(2) = -K2*xerr; 

% If there is no water in ballast tank-2 and flow rate for pump-2 is negative, then turns off the 
pump 
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if (u(6) <= 0 & weur(2) < 0); 
weur(2) = 0; 

end; 

weur = [weur(1);wcur(2)]; 

end; 


% end weightcont 





% SaaS SSS SSS 
% speedcont 


% Controls the forward speed 





0 ——$—$—S—————— 


function vcom = speedcont(u) 


% Current velocity 

veur = u(1); 

% Current depth 

zcurrent = u(2); 

% Commanded depth of flight 
zcom = u(3); 

Z= esta - zcurrent; 

% Current longitudinal location 


xreal = u(5); 


% Commanded longitudinal location 


xcomm = u(6); 


% Bottom depth 

zemd = u(7); 

location = xcomm - xreal; 

% deceleration 

acc = 0.625; 

% Forward speed during the flight 
Vo = u(4); 


WZ 





% Time 

t = Vo/acc; 

xstop = Vo*t-0.5*acc*(t*2); 

zvert = zgrnd - zcom; 

tvert = zvert/0.11; 

xstop2 = 0.6*tvert + 9; 

% Distance needed to complete stop 
xstop1 = xstop + xstop2; | 


% Checks if the vehicle is in the commanded depth and reduces to speed 


if abs(z) < 0.05; 
if location < xstop1; 
vcen = abs(u(1) - 0.1) ; 
if vcen > 0.1; 
vcom = vcen; 
else 
vcom = 0.1; 
end; 
else 
vcom = u(4); 
end; 
else 


vcom = u(4); 
end; 


% end speedcont 








a  ————————————— 


% seccont 


% Keeps the vehicle’s velocity at 0.1 ft/sec during grounding 





% eos SSS SSS 


function vsec = seccont(u) 


% Difference between bottom and current depth 
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gmd = u(4) - u(S); 


if (u(1) > 0 | u(3) > 0); 


vsec = 0.1; 
elseif grnd > 3; 
vsec = 0.1; 

else 
vsec = u(2); 
end; 


% end seccont 


Of aE a —T—o—E ee _—eooo——_ 


% planeangcont 
% Keeps the plane angles at 0 degree during grounding 
a 
function ang = planeangcont(u) 
if u(1) > 0.1; 
ang = u(2); 
else 
ang = 0; 
end; 
% end planeangcont 
Of 
% grounddepth 
% Stops the simulation at the ground depth defined by the user 
Of 
function grnd = grounddepth(u) 
% Bootom depth 
ground = u(1); 
% Current depth 
actdpth = u(2); 


if actdpth > ground; 
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grnd = ground; 
else 

gmd = actdpth; 
end; 


% end grounddepth 
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APPENDIX B 
The parameter values used to simulate the dynamic behavior of the NPS Phoenix are 
given in this appendix : 


A. PHYSICAL PARAMETERS 


W Vehicle Weight = 435 Ibs 

B Vehicle Buoyancy = 435 lbs 

L Characteristic Length = 94 in. 

L, Bow Ballast Tank Offset from C.G. = 24.25 in. 

L, Stern Ballast Tank Offset from C.G. = 14.75 in. 

I. | Moment of Inertia = 42 Ib-ft-sec’ 


XG x Coordinate of C.G. From Body-Fixed Ongin =0.0in 
Xp x Coordinate of C.B. From Body-Fixed Origin = 0.0 in 
Zp z Coordinate of C.B. From Body-Fixed Origin = 0.0 in 
ZG z Coordinate of C.G. From Body-Fixed Origin = 0.5 in 
B. CONTROL INPUTS 
dp Bow Plane Deflection 
5; Stern Plane Deflection 
f; Bow Ballast Pump Flow Rate 
f, Stern Ballast Pump Flow Rate 
C. NON-DIMENSIONALIZED HYDRODYNAMIC COEFFICIENTS 


Z', =-0.00253 Z', =-0.09340 Z' -=-0.07013 
Z', =-0.78440 Z;, =-0.02110 Z;, =-0.02110 
Mi, =-0.00625 M;, =-0.00253 M’ =-0.01530 


M’, =0.05122 M,. = -1.7664 M;, = 1.3260 
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